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1. INTROPU 


WMWS 


The objectives of this research were to develop techniques of controlling a 
dc-motor driven flywheel which would apply torque to the structure to which it 
was mounted. The motor control system was to be implemented using a 
microprocessor based controller. The purpose of the torque applied by this 
system was to dampen oscillations of the structure to which it was mounted. 

Before the work was terminated due to the unavailability of equipment, a 
system was developed and partially tested which would provide tight control of 
the flywheel velocity when it received a velocity command in the form of a 
voltage. 

The procedure followed in this development was to first model the motor and 
flywheel system on an analog computer located at Old Dominion University. Then, 
prior to the time the microprocessor development system was available, an analog 
control loop was designed and tested. When the microprocessor development 
system became available, the analog control loop was replaced by the 
microprocessor and the system was partially tested. 


2. AN ALOG SIMULATION 
2.1 Motor Model 

From tests and specifications on the motor, the following transfer function 
for the motor was determined. (See Fig. 2) 

K 

JS + B 

where 


K = 4.02 oz in/A 
J * 5.096 x 10” 2 oz in s 2 
B - 2.0 x 10" 3 oz in s 

A current amplifier was employed to power the motor. Its gain, G, was 0.5. 
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V. ~ Js + B "" s + 0.04 
in 


2.2 Compensator 

It is desirable to move the pole further from the imaginary axis to speed 
up the transient response time. To accomplish this output feedback and a lead 
compensator is used. 


Compensator: C(s) = 

s ( s + 5 ; 


This provides a settling time of 1.6 seconds (to within 2% of steady state 
value) . Choosing a damping coefficient of 5 = 0 .707 , we obtain the root locus 
in Fig. 1. 


Closed loop 
pole position 
for an open 
loop gain of 12.5 


-2.5 


For an open loop gain of 12.5, 


thus. 


40A = 12.5, A = 0.312 


x _ 0 . 312 ( s + 0.04) 
” s (s+5) 


Fig. 3 shews the actual motor model with the compensator. Fig. 4 describes 
the response time of the motor to a step input without the compensator. Fig. 5 
describes the response time with the compensator. 


BLOCK DIAGRAM OF CLOSED-LOOP SYSTEM 
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MOTOR SPEED vs TIME (l) 
INPUT VOLTAGE vs TIME (2) 


CK; f ° 



Conditions: 

1 • Motor driven by compensator 
and current amplifier. 

2. Flywheel attached to motor. 

3. Step input where reference 
speeds 1000 rpm. 


I 4 


8 SEC 


Fig. 5 
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3.1 System Description 

The M68KDM design module was used to develop the digital control loop. On- 
board components include the following: 

One Motorola M680Q0 16-bit microprocessor 

32-kbytes of RAM 

One 8-kbyte System Monitor (MACS3UG) 

IWo Synchronous Communication Terminals (ACIA) 

TSio 16-bit Peripheral Interface Devices (PID) 

One Programmable Timer Module (PTM) with three timers (TL,T2,T3) 

The system includes an assortment of pin-outs for control signals, voltages 
and ground terminals. The system clock and baud rate can be changed to suit 
user requirements as well. 

3.2 System Connect 

The NASA-LRC computer was connected through the "Host" ACIA, and our 
terminal was connected through the "Terminal" ACIA. With this arrangement, oaly 
one command was necessary to switch between the NASA computer and the M68KDM. 
This made programming easier since it was possible to jump quickly frrm the 
assembler to the microprocessor to check programs. The NASA-LRC made available 
compilers that handle both Pascal and MC68000 assembler code. It is even 
possible to use both in the same program by linking them in the downloading 
process. For our purposes the assembler code was sufficient, though we did 
experiment with the Pascal and found it very useful for more complicated 
programming. 

3.3 MC68000 Microprocessor Description 

A more detailed explanation of the microprocessor itself will prove helpful 
in understanding the programming. The following facilities are available to the 
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Registers 

(8) 32-bit Data Registers 

(7) 32-bit Address R&ffisters 

(2) 32-bit Stack Pointers (Supervisor/User) 

(1) 16-bit Status Register 
Program Counter 

16-Mbyte direct addressing range 
56 powerful instruction types 
Operations on five main data types 
Memory mapped I/O 
14 Addressing modes 

The data registers can be used for byte (8-bits) , word (16-bits) , or long 
word (32-bto) data operations. The address registers and stack pointers can be 
used as base address register?* and software stack pointers. These same 
registers can also be used for word and long word address operations. Ary and 
all of the registers can be used as index registers. 

The status register contains the condition codes on the lower byte. She 
upper byte contains an 8-level priority interrupt masking ability, 
Supervisor/User state control, and trace mode state control. Hie trace mode 
state can be used to single step through a program displaying all registers 
after each step. There are still six unused bits in the status register, lhese 
make room for any extensions of the MC68000 family. Understanding this register 
is critical in programming. 

Hie condition codes have a direct effect on ary testing procedures. It is, 
therefore, very important to note the effects on the condition codes of ary 
instruction before a decision block in the program. Understanding the interrupt 
masking system is also important. Whenever an interrupt is serviced, that level 
of interrupt, and all those below, are automatically masked until a Return from 
Exemption (RTE) is served. In this way the interrupt remains the higher 
priority routine. Only an interrupt of higher priority can be serviced at this 
time. This register is depicted in the following figure: 


io 


bit: 


Trace Mode — — 
Supervisor/User 
Interrupt Mask 
Condition Codes 
////// - unused 
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The 5 main data types mentioned are as follows: 

1. Bit 

2k BCD Digits (4-bits) 

3. Bytes 

4. Words 

5. Long Words 

The 14 addressing modes are derived from the following 6 basic types: 

1. Register Direct 

2k Register Indirect 

3 . Absolute 

4 . Immediate 

5. Program Counter Relative 

6. Implied 

1, powerful aspect of the register indirect addressing mode is the 
capability of post- incrementing, pre-decrementing, offsetting, and indexing. 
This is by no means a comprehensive look at the MC68000' s capabilities. 
However, it does lend insight into the power and versatility of this one 64-pin 
chip. Especially useful, and equally complex, is the variety of interrupt and 
exception processing control available. Combining these with the 1000 plus 
instruction set leads to quick decision making and data processing. 

Sane specifics involving the PID' s and the PTM can be found in Appendices I 
and II. 


4. DIGITAL . WO E.J3 VM /IW 

The closed loop system as shown in Pig. 2 was modified to accommodate the 
digital device in the control loop. (See Pig. 6) The motor velocity which is 
represented by an analog voltage in the analog computer was converted to a 
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digital signal by applying it to the input of a vol tage- to-f r cquency converter 
followed by a D flip flop. The output of the flip flop is a rectangular wave 
whose pulse length is inversely proportional to the motor velocity. By counting 
clock pulses gated by this flip flop output, a digital number indicating motor 
velocity is developed. This process is explained in the sequel (paragraph 6,2). 

The motor velocity is compared with a voltage which will be a measure of 
the desired motor velocity. This voltage is called the reference signal. It 
will be normalized and digitized as explained (paragraph 6.1) and the comparison 
made in the microprocessor. This comparison will produce an error signal and 
this signal will be used to actuate the motor. In the case where a compensating 
filter is not present, an offset will have to be added to the error which will 
keep the motor running at a nominal speed when the error is zero. Since the 
compensating filter adds an integration, the offset can be dropped. 

A digital filter was developed to do the compensating. This filter accepts 
the error signal from the comparison operation and produces the digital 
equivalent of the actuating voltage. This, after D to A conversion is input to 
the power amplifier driving the motor. 

5. SOFTWARE DESIGN 

5.1 Program Initialization 

The initialization procedure for the program need only be processed once. 
This sets up all necessary addresses, ports timers, and any initial values used 
in the main program. The following description steps through the initialization 
process. Upon examining the program comments, one can follow the process. 

The first part of the initialization involves setting label addresses. It 
is often easier to remember a label than an address. This is done for all 
often-used addresses. When programming then only the label need be used. The 
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assembler will place the correct address. These labels represent control 
registers, data registers, and scratch-pad memory locations. 

The second part of the procedure involves the actual initialization. 
First, both parts of PID 1 are set as output ports. The control interrupt input 
lines CA1 and CB1 are set to be positive-edge triggered. After each port is 
initialized, the peripheral data registers of each is cleared of ary "floating 
data". 

PID 2 is initialized in the same manner. However, the most significant bit 
of port B i r. set as an input. The remaining seven are set as outputs. 

The next step is to program the timers. An explanation of how these are 
programmed can be found at the end of this report. The final step in this 
process is to assure the timers are enabled by clearing the least significant 
bit of timer number 1 CEL) . 

All that remains is to set initial values for ary variables used, and to 
set memory locations for exception processing routines. In the following 
program can be found all the initialization for the active programming done. 
Later in the report routines that were unable to be implemented due to logistic 
problems will be discussed. Any further initialization needed for these 
routines will be discussed in their respective sections. 

The program is now ready to begin. Once in the main program, this 
procedure will never be entered again. Instead we will always branch to the 
head of the main program. 


Initialization Program: 


LABEL [ OP CODE 1 OPERAND I COMMENTS 


PIAD 

1 

Equ 

I $ 3 F F 4 1 

I SET 

LABELS 

PI AC 

1 

n 

[ $ 3FF45 

1 

ii 

PIBD 

1 


1 $ 3 F F 4 3 

1 

ii 

PIBC 

1 

ii 

1 $3FF47 

I 

it 

PIBD2 

1 

it 

1 $3FF42 

1 


PIBC2 


ii 

| $3FF46 

I 

ii 

PTMCR1 

1 

n 

1 $3FF61 

1 

n 

PTMCR2 

1 

ti 

| $3FF63 

1 

n 

PTMCR3 

1 


1 $ 3 F F 6 1 

1 

ii 

PTMC2 

1 

it 

| $3FF69 

1 

ii 

PTMC3 

1 

H 

1 $3FF6D 

1 

it 

MSBB3 

1 

n 

| $3FF6D 

1 

ii 

INIT 

1 

ii 

| $6000 

1 

ii 

BUF 

1 

H 

| $6010 

1 

ii 

REF 

1 

n 

| $6020 

1 

n 

SVBT 

1 

ii 

I $6030 

1 

it 

CLBT 

I 

1 

it 

I $6040 
1 

1 

ii 


1 

1 

MOVE.B 

10800101010, PIAC 

| PIAD — » Data dir. register 

i 

i 

MOVE.B 

|0$FF , PI AD 

| C o n f ' i g 

entire port as output 


MOVE.B 

| 08001 01 1 1 0 , PI AC 

|PIAD—> Data register 



CLR.B 

i PI AD 

1 





MOVE.B 

| 08001 01 01 0 , PIBC 

p 





MOVE.B 

| #$FF , PI BD 

I, 

> Same 

as PID1-A 



MOVE.B 

10800101110, PIBC 

1 





CLR.B 

|PIBD 

\) 





MOVE.B 

10800101010, PIBC2 

i 





MOVE.B 

| 0$7F , PI BD2 

1 MSB — y 

input , remainder out 


MOVE.B 

108001 01 1 10, PIBC2 

1 





CLR.B 

| PIBD2 

1 





MOVE.B 

10810010010, PTMCR2 

lAccesses T3 control 

register 


MOVE.B 

| 081001001 1 , PTMC R3 

SSets T3 timing mode 


MOVE.B 

1081001001 1 , PTMCR2 

lAccesses TI control 

register 


MOVE.B 

10$ D2 , PTMCR1 
|0$FFFF,INIT 

lEnables all timers 


MOVE. W 

P 





MOVE.W 

1 1 N I T , DO 

1 

Sets 

init value 



MOVE.L 

| 0MS6B3 , AO 

1 

r in 

T3 latch 



MOVEP.W 

| DO, 0( AG) 

0 





MOVE 

|0 $8080, SVBT 

1 Saves 

a bit in ATOD 



MOVE 

I 0$7F7F , CLBT 

1 Clears 

a bit in ATOD 



MOVE.L 

I0AINT, $006C 

I $006C 

<AINT> 



MOVE.L 

I0BINT ,$0070 

1 $0070 

<• — <BINT> 



MOVE.L 

| 0BNDCHK ,$0018 

I $0018 

f — <BNDCHK> 



ORIGINAL Pmi ffi 

OF POOR QJJAUTY 


15 


6 . 
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Mounted on the flywheel in the torque system is a printed disk with black 
and white segments alternately spaced around the circumference. There are 
exactly 60 black and whits pairs evenly spaced. When the flywheel spins an 
electrooptical pickup produces a rectangular pulse train with the pulse lengths 
being inversely proportional to the wheel velocity. The voltage to frequency 
converter coupled with the D flip flop is analogous to this system in the 
simulation. The value of motor velocity, after this transduction, is to be 
compared with the reference velocity. 

This routine constitutes what might be called the Main Program. For 
variations of the program additions to or deletions from this routine will be 
made. Our objective is to sample the reference signal, compare it to the motor 
speed and feed the difference to the compensator-motor model. 

6.1 Reference Service Routine 

To determine the signal needed to send back to the motor, use was made of 
the PTM on board the M68KDM. of the three timers available, two are used. T2 
is used as a continuous clock to regulate the sampling time of the reference 
signal. The lowest sampling rate while using just one countdown clock is 
approximately 12.2 Hz. Assuming a maximum sinusoidal input frequency of 100 Hz, 
this sample time is quite adequate. This sample time corresponds to a latch 
input of $FFFF when using the internal clock input of 8xl0 5 Hz. This clock 
(T2) will then initiate a priority four interrupt (BINT) every 82 msec. When 
servicing this interrupt request the subroutine AUDD will be called to take a 
sample of the reference signal. 

ATOD is designed to perform an analog- to-digital conversion on ary positive 
voltage level between O.and 10. (This routine is discussed in Section 7). 
Since it is possible to have a reference that is negative, the digital reference 
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voltage (REF) has to be manipulated in the service routine before it can be used 
to determine an error in the main program. 

A description of this reference signal, and what is actually sampled will 
help at this point. A graphical explanation is easiest to understand. A 
typical signal showing maximum and minimum values is in Fig. 7. 



Before performing the Vt> conversion, we add a +5 volt dc offset to assure 
a positive signal. (See Fig. 8) The Vd conversion is then made. 



REF from ATOD is a 4-byte word. In order to assure the most significant two 
bytes are $00 a logic OR operation is performed on REF and $FF00. REF is now a 
two byte positive digital equivalent to our signal. The manipulation can now be 
done to give us a workable error. 
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The zero axis corresponds to $80. Since the conversion takes place on a 
full two byte scale, it must be scaled down. Otherwise the motor will 
constantly be over driven. At the same time the offset must be removed to allow 
a negative error. Hence, the following is done in the service routine. 


ref «- 

?OA 

REF is now a usable digital equivalent of the sampled reference signal. This 
value will be used in the main program to determine the error to be sent back to 
the motor. 

6.2 Motor Velocity (Main Program) 

To determine the motor speed use was made of timer 3 (03) . T3 is used to 
measure the pulse width of the output of the voltage-to-frequency converter. 
The length of this pulse is inversely proportional to the speed of the motor. 
T3 decrements from its initial value ($FFFF) until stopped. This count 
represents the pulse width. Use was made of T3's option that will enable its 
clock frequency to be at 10 1 2 3 4 5 Hz. With the V/F output tied to the gate input of 
03 the timer acts as follows. (See Fig. 9) 


4 

gate input 




1 


Fig. 9. Velocity Transducer Gating 


1. Initial value loaded into T3 ($FFFF) . 

2. Counter enabled, thus decrementing initial value, 10 5 counts per 
second. 

3. Interrupt triggered, decrementing has stopped. 

4. Count is held until reinitialized by (1). Microprocessor fetches 

count. 


/ 
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The interrupt created by this clock is of priority 3. This assures 
that a constant sampling time (priority 4) is maintained. The priority 3 
interrupt (AINT) increments a flag (DO) and then returns to the main program. 
In the main program we wait for two of these interrupts (DO=2) before fetching 
the count from T3. This assures us that we have not begun decrementing before 
the initial count is set. 

Once the proper decremented count is reached, it is subtracted from the 
initial value, resulting in the actual count. Since this count is inversely 
proportional to the actual motor velocity, we subtract REF from the count. 
Before sending this digital voltage back to the motor model, we first must make 
some changes and check the bounds to be sure the error is between $00-$FF 
(remember, the D/A converters operate on positive numbers only) . 

First, $80 must be added to move the zero point to mid-range of the scale. 
When the compensating integrator is put in the loop, this offset should be 
removed and the pure error signal fed to the digital filter. After offsetting 
we use a Check Register Against Bounds command which assures that we do not 
overflow our D/A range. This command holds the error signal being sent back to 
the motor to within its respective bounds given an overflow at those bounds. 
This is a powerful and very useful command. The last step is to send the error 
signal to the motor model, and then return to the top of the program to repeat 
the routine. 

At this point in the development, testing was interrupted when the 
development system was called back to NASArLRC for another task. Before its 
recall this system was displaying intermittent spurious outputs. Several 
components were replaced and this problem was corrected. 

The testing which was in progress when the equipment was returned would 
have answered several questions. These concerned the scaling of the ATOD result 
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and its effect on the motor actuating signal and another method of transduction 
of the motor velocity. 

A flow chart of the main program as well as the exception processing 
routines is shown in Pigs. 10 and 11 respectively. These are followed by the 
routine itself in assembler code. 
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ftiCL: 


Main (Pulse Width) 

3 roqram 

LABEL 

| OPCODE 

I OPERAND 

START 

| CLR 

I DO 


l MOVE . B 

1 #$2F,PIAC 

WAIT 

| MOVE . B 

I #$2F , PIBC 


| CMPI 

I #2, DO 


| BNE 

) WAIT 


| MOVE ,B 

| #$2E,PIAC 


| MOVE . L 

I #PTMC3 , AO 


| MOVEP.W 

I 0 ( AO ) , D2 


| MOVE . W 

I INIT, BUF 


| SUB.W 

| D2 , BUF 


1 MOVE . W 

| BUF ,D3 


[ SUB.W 

I REF , D3 


i ADDI 

| #$0080, D3 


1 CHK 

| #$00FF,D3 


i MO VE . B 

| D3 , P IBD 


I BRA 

| START 

AINT 

| MO VE . B 

| PIAD, PIAD 


| ADDI 

1 #1 , DO 


! RTE 


BINT 

| MOVE . B 

| PIBD, PIBD 


I OR I 

| #$FF00 , REF 


| MOVE 

I REF ,D7 


! SUB.T 

I #$80, D7 


| DIVS 

1 #$0A,D7 


| MOVE . W 

| D7 , REF 


j RTE 


BNDCHK 

| BMI 

| NFG 


| MOVE . B 

1 #$FF,D3 


I BRA 

} HOME 

NEG 

| MOVE . B 

I #$00, D3 

HOME 

| RTE 



OF POC 


<r if > 

'ii « 


« 

fA 


COMMENTS 


I’i 

} 


Clear count flag 
Enable AINT { l trigger) 

Enable BINT (j trigger) 

Count flag = 2? 

If not branch to wait 
Mask AINT 

Fetch final value in 
T3 to date register D2 
BUF<r~ INIT 
BUF < — BUF-D2 
D34— BUF 
D34— 03 - REF 
D34— D3+$80 

If $FF<03<$00 3MP to BNDCHK 
Sends error to output port B PID1 
Repeat procedure 

Reads PIAD to clear interrupt request 
Increment count flag 
Return from exception 


Reads PIBD to clear 
REF < — (REF)OR(FFOO) 
074— REF,. 


interrupt request 


REF < — 


R£F-$8Q 

I 


Return from exception 


Branch to 
Otherwise 
Return 
Error (D3) - * 
Return from 


NEG if error 
error ( D3 ) *— 


negat i ve 
$FF 


- $00 

exception 


23 


7, ANALOG TO DIGITAL CONVERSION - ATOO 

In order to assure a constant conversion time the successive 
approximation technique for the analog to digital conversion 
was used. The conversion is based on a 0-10 volt range. This 
range, using 8 bits, provides the following quantization level: 

6 : 10 s 0.04 volt 

The hardware was available to use 16 bits, however, it can be 
seen that using only 0 bits is not only sufficient from a 
quantization level viewpoint, but also saves time. The faster 
a conversion is made, the more time there is available for 
other programming. 

The method of successive approximation is quite simple. The 
idea is to successively split the 8 bit digital signal. On 
each split the signal is sent to a D/A converter where it is 
compared to the analog signal being sampled. For each test, 
a decision is made whether to keep the last bit tested. The 
process is outlined below: 

I* The MSB of data is set high. 

2. If the comparator output is high, the bit is saved. 
Otherwise it is cleared. 

3. Continue the above process until each successive bit 
has been tested. 

A comparator is used to compare the error signal (after the 
previously mentioned +5 volt dc offset) and the test signal, 

The test signal is greater than the error on a high comparator 
output, and less than the error on a low output. Since the 
M68KDM operates at such a high speed, a short delay was neces- 
sary between sending the test signal and reading the comparator 
output. This enabled the external circuitry time to perform 
its function. 

Following is a description of the terminology used in both the 
flow chart and program. The flow chart is shown in Figure 12. 

D4 (Data register 4) 

D4 contains the output of the comparator. It is read 
through PID2-B. 

D5 (Data register 5) 

D5 is used as a counter to determine when all 8-bits have 

been tested. 

D6 (Data register 6) 

D6 contains the test signal. Only the least significant 
8-bits are used. 




» 
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SVBT (Save bit) 

SVBT is initialized in the initialization routine to $8080. 
It ia used to set up each successive bit to be tested. It 
must then be rotated to each next bic to bo tested. A log- 
ical OR operation is then performed on SVBT and the 8-bit 
test signal, 

CLBT (Clear bit) 

CLBT is initialized in the initialization routine to $7F7F . 
It is rotated to follow the bit being tested. When this 
bit has to be cleared (comparator output low) a logical AND 
operation is performed on the test signal and CLBT. Though 
only the least significant 2-bytes are needed, both CLBT and 
SVBT are 4-bytes to simplify rotation, 

REF (Reference voltage) 

REF contains the final digital voltage equivalent to the 
error signal. To simplify programming, REF is constantly 
updated. Using a number of test and branch statements may 
speed up the conversion process by addressing REF just once 
for each sample. 

The routine has proven quite accurate and presented few problems, 
Equipment problems did not permit the opportunity to note the 
actual conversion time. 

























ATOP Program 


LABEL | OPCODE 1 OPERAND 1 COMMENTS 


ATOD 

| MOVE 

1 // 8 , D 5 


I MOVE 

| SVBT ,D6 

..OOP 

| MOVE . B 

| D6 , P I AD 


) NOP 



| NOP 

1 


| NOP 

1 


) NOP 

i 


| MOVE.B 

| PIBD2 ,D4 


| CMPI 

|#0,D4 


| BNE 

| NEXT 


| AND u B 

| CLBT , D6 


| MOVE 

| D6 , REF 

NEXT 

| ROR 

| SVBT 


I OR . 8 

| SVBT ,D6 


I ROR 

1 CLBT 


| SUBI 

I in , D 5 


| CMPI 

I #0 , D5 


| BNE 

I LOOP 


I RTS 

1 


Set count 

Set MSB to be tested 
Send 8-bit test to D/A 

Delay for external 
circuitry 

Read comparator output 
Comparator = 0? 

If not save last test bit 
Clear last test bit 
REF <— D6 

Move to next test bit 
Set next test bit 
Follow test bit with CLBT 
Decrement count 
Finished conversion? 

If not continue process 
Return from subroutine 


8, DIGITAL COMPENSATOR 
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The analog compensator can easily be programmed into the 
microprocessor without changing the system block diagram signifi- 
cantly. However, more of the functions will be implemented in 
software as shown below: 


^ R(z). 

E!z) 

■ D(z) 

U(z) | __ 

■ d/a 


Motor 

Model 

C(s) 

1 

r > 

" y 

i 

i 




C(z) 

^ 

i 

i 

i 





Microprocessor External Components 


Design: 

We know D(s) = 0.32 ( s+Q . 04) 

s"( s + 5 ) 

Using Pole-Zero mapping; z = e a "T 


Solving for K 


T = 0.082 sec. 

D(z) = K ( z-0 . 9677 ) ( z + 1 ) 
( z — 1 ) (z-0.6637 ) 


sD(s) L = (z - i)d(z) /,., 

( 0 . 32 ) ( 0 . 04 ) = K ( 0 . 0323 ) ( 2 ) 

5 0.3363 

K = 0.1333 

Hence, D(z) = U(z) = 0 . 1 333 ( z-0 . 9677 )( z+1 ) 

ElzT (z-1 ) (z-0.6637) 

U (z) [z 2 -1 . 66 37z+0.66 3 7] = 0.1 33 3E(z) [z 2 + 0 .’03 23 z-0 . 9 677] 

U(z) [l-1 .6637z" 1 +0.6637z 2 j = 0 . 1 333E ( z )[ 1 +0 . 0323 z“ 1 -0 . 9677 z" 2 ] 

This leads to the difference equation: 


u(k)=0.1333e(k)+0.0043e(k-1 ) -0 . 1 290e ( k-2 ) +1 .6637u(k-1 ) -0 . 6637u ( k-2) 

It is immediately apparent that there will be a problem on 
initially starting our system. The output of this filter, and the 
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corresponding input to the motor, depends upon previous inputs and 
outputs. This problem will be handled in the initialization routine. 
We will set up initial values assuming the motor is operating at its 
steady state 1000 Hz rate. This then suggests that: 

a) _ 40 

v " r+ .64 

at steady state: s « 0, w * 1000 

1000 . 40 
V " .04 


V = 1 

At steady state E(z) = 0, therefore e ( k ) « 0. Assuming 
e(k-2) = u ( k-2 ) = 0: 

U ( k ) = 0.0043 e(k-l) + 1.6636 u(k-l) 

Letting u(k-l) - e(k-l), and u ( k ) = 1 

u ( k-1 ) = e ( k-1 ) = (0.5995) 1 0 

The routine is designed to be compatible with the labels and 
registers used in the existing main program. The digital filter 
will be inserted just after the error calculation in the main pro- 
gram. This location has been noted on the Pulse Width flow chart 
with an asterisk. 

The multiplication will be done using the ALU board supplied. 
The documentation for this board is not readily available. There- 
fore, the multiplication procedure will be displayed as a separate 
block. The flow chart is shown in Fig. 13 followed by the program 
in assembler code. 


D i g i t a 1 Filter F 1 o Vv 

















Compensator Program 


LABEL 

I OPCODE 

I OPERAND 

1 

EO 

IEQU 

1 $5000 

1 

El 

|EQU 

| $5002 

1 

E 2 

1 EQU 

I $5004 

1 

UO 

IEQU 

1 $ 5 0 0 A 

1 

U1 

1 Equ 

| $5006 

1 

IJ2 

IEQU 

| $5008 

1 


IMOVE.B 

1 (0.5995),, , E 1 

1 


1 MOVE.B 

| # $ 0 0 , E 2 

1 


I MOVE.B 

| ( 0 . 599 5 ) ;t> , U1 

1 


IMOVE.B 

| 

| # $ 0 0 , U 2 

l 

1 

1 

Filter 

IMOVE.B 

1 

| D3 , EO 

1 

I 

-J 


| EO (0 

. 1 333 ) w EO 

1 


i El (0 

. 0043 ) (l? El 

1 


IE2 (- 

0 . 1 2 9 0 )„> E 2 

1 


l U 1 (1 

. 663 7 ), u U1 

1 


IU2 (- 

0.663 7 ) H , U2 

1 


IMOVE.B 

I U 2 t A 0 

H 

1 


1 MOVE.B 

| EO ,U0 

l 

FLOOP 

I ADD . B 

I AO , UO 

1 


| SUB . I 

| #2 , $A0 

1 


1 CMP I 

|#$5000,$A0 

1 


I BNE 

| FL OOP 

i 


IMOVE.B 

1 U 0 , D 3 

1 


IMOVE.B 

1 El , E2 

1 


IMOVE.B 

j E 0 , E 1 

1 


| MOVE.B 

| U 1 , U 2 

1 


IMOVE.B 

I U0,U1 

1 


| COMMENTS 


This section is in the 
initialization routine 


Initializes filter values 


. 


e (k ) 


error 


ALU multiplication 


} 


Sets up first addition 


Add 

Next addition 
F inished? 

If not branch to continue 

Data register 3 gets filter output 

Set values for next sample time 
difference equation calculation 
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The procedures and programming discussed assume the motor is running near 
its steady state speed. A separate start-up routine will have to be devised to 
accomplish this. 

There were some problems encountered on the project. Exception processing 
initially proved to be quite a challenge. The documentation supplied did not 
clearly explain how the MPU determines a vector address for servicing these 
exceptions. Since most of our control depends on interrupt servicing, the 
problem had to be overcome before any real progress was made. With help from 
the people at NASA-LRC, the problem was solved. Understanding the Trap Error 
exception was even more difficult than that of the interrupt exception. For 
most of the different Trap Errors possible the vector address for the service is 
floating. It does not remain the same, but changes with respect to the program 
counter and previous instruction handled. 

Wirewrapping on the M68KDM was not a big problem. The documentation was 
vague here also, but examination of the board's schematic diagram answered these 
questions. The IRQ lines and inputs had to be wirewrapped to the peripheral 
devices and the MPU. The data sheets on these peripheral devices provided clear 
and concise instructions for their use and programming. Hiere were only a few 
small problems involving the instruction set. Some of the peripheral commands, 
subtraction, and division required careful manipulation. Except for the 
material on exception processing the system documentation was generally 
satisfactory. 
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Appenolix I 

Peripheral Interface Device (PIP) 

There are six addressable registers within each PID, three 
for each of the two ports. Ports A and B each contain a data 
direction register (DDR), control register (CR), and a peripheral 
data register (PDR). Each port also has an interrupt input 
control line (CA1/CB1) and an input/output peripheral control 
line (CA2/CB2). The DDR and PDR each share the same memory 
address. Bit-2 of the control register determines which of these 
is being addressed. This control register is programmed to 
determine how the control lines are used. 

Control Register (A/B) 


JCRQ1 

I R Q 2 

C 2 ( A /B ) control 
DDR(A/B) access 
Cl (A/B ) control 


7 

6 

5 

4 

3 

2 

1 

0 





Bit-0 

Bit-1 

Bit-2 

Bits-3 , 4 , 5 
Bits-6 , 7 


1 Interrupt enabled 

0 Interrupt masked 

1 Interrupt positive edge triggered 

0 Interrupt negative edge triggered 

1 DDR selected 
0 PDR selected 

Determine control and interrupt reaction to CA2/CB2. 
This control differs slightly for each port. 

Set on active transition of respective interrupt and 
control signal. These interrupt requests can only be 
reset by a read peripheral data operation on that 
port . 


To initialize each port, the fallowing procedure is used: 


1 . Select DDR 

2. Program input/output lines 

3. Program control lines, select PDR 

4. Set initial data values at port 



MrttSLLTv 
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Appendix II 

Programmable Timer Module (PTM) 

The PTM contains three separate timers. The three operate in- 
dependently of each other and are essentially the same. Each 
can use the internal 0.8 MHz clock source or an external clock. 
Each has accessible: 

(1) 8-bit Control Register 

(1) 16-bit Latch 

(1) 16-bit Decrementing Counter 

T3 has the added option of a divide clock by 8 function. This 
was used along with the internal clock to produce a 0.1 MHz 
clock. The latch is used to preset the count for the timer. 

The counter, when enabled, is then decremented from this initial 
value until disabled. The gate input is used to trigger the 
counter . 

There are a number of control word formats which set up dif- 
ferent timing mechanisms. The PTM is very useful, in that it 
operates independently of the microprocessor, thus, freeing the 
microprocessor for other tasks. Upon comleting its function, 
the timer signals the MPU to fetch its data, and may then con- 
tinue another function. 

The control registers for T1 and T3 share the same address. 

T2's control register selects which is being addressed. An 
explanation of the register control notation follows: 

CR1 T1 Control Register 
CR2 T2 Control Register 
CR3 T3 Control Register 
CRX All Three Control Registers 

The number immediately following these three characters refers 
to the specific bit in the control register. The following 
figure depicts the individual bit assignments for any given 
timer function. 


TIMER PROGRAMMING 


BIT 

1 

VALUE 

I DESCRIPTION 

CR1 0 

1 

0 

I All timers enabled 


I 

1 

1 Timers held at preset state 

CR20 

1 

0 

1 CR2 may be written to 


1 

1 

I CR1 may be written to 

CR30 

1 

0 

1 T3 clock not prescaled 


1 

1 

1 

I T3 clock prescaled by 8 

CRX1 

1 

1 

I 

0 

1 

i Clock Source 
1 External clock 


1 

1 

1 

I Internal clock 

t 

CRX2 

1 

1 

1 

0 

1 

i Counting Mode Control 
1 Normal 16-bit mode 


1 

| 

1 

i Dual 8-bit mode 
1 

C R X 3 j 

4,5 | 

i 


1 

1 Counter Mode and Interrupt 
1 Control (see below) 

1 

CRX6 

1 

I 

1 

0 

1 

| Interrupt Enable 
1 Interrupt masked 


1 

I 

1 

| Interrupt enabled 

CRX7 

1 

1 

1 

0 

1 

1 Output Enable 
j Output masked 


I 

1 

| Output enabled 

CRX3 

CRX4 

CRX5 

Timer Operating Mode 

0 

# 

0 

Continuous 

0 

* 

1 

Single Shot 

1 

0 

* 

Frequency Comparison 

1 

1 

* 

Pulse Width Comparison 


(* determines additional timer functions) 


Appendix III 


$3FFFF 

$21 FFF 
$20000 

$Q7FFF 

$3FF6D 

$3FF4Q 

$7000 

$5000 

$3000 

$06FF 

$0400 

$0070 

$0060 

$001 8 
$0000 


SYSTEM MEMORY MAP 


I/O (2 kbytes) 


MACSBUG, System Monitor 
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Peripheral Device Registers 


Scratch Pad 



Bound Check 
BINT 
AINT 


Main Program 
Initialization 



MACSBUG, System Monitor 



Priority 4 interrupt (BINT) 
Prio r it y 3 interrupt (AINT) 


Bound Check Service Vector 



L 



